/*
 * @Description: 
 * @Author: Sang Hao
 * @Date: 2021-09-15 17:15:26
 * @LastEditTime: 2021-09-22 10:31:09
 * @LastEditors: Sang Hao
 */
#include "lidar_slam/sensor_data/pose_data.hpp"

namespace lidar_slam {
Eigen::Quaternionf PoseData::GetQuaternion() {
	Eigen::Quaternionf q;
	q = pose.block<3, 3>(0, 0);
	return q;
}	
}